#ifndef SIMPLEROBOTICMATH_H
#define SIMPLEROBOTICMATH_H
void d4MatrixInverse(double Matrix[4][4],double (&InerseMatrix)[4][4]);
void d4MatrixPlus(double MatrixA[4][4],double MatrixB[4][4],double (&PlusMatrix)[4][4]);
void d4MatrixMultiply(double MatrixA[4][4],double MatrixB[4][4],double (&MultiplyMatrix)[4][4]);
void d4Matrix2EulerZYX(double Matrix[4][4],double (&PosXYZ)[3],double (&EulerZYX)[3]);
void EulerZYX2d4Matrix(double PosXYZ[3],double EulerZYX[3],double (&Matrix)[4][4]);
#endif // SIMPLEROBOTICMATH_H
